(NASA-CB-136070) GRADIENT ESTIMATES FROM 
STEREO MEASUREMENTS FOR A MARTIAN VEHICLE 
M*5. Thesis (Rensselaer Polytechnic Inst.) 

70 p HC $5.50 CSCL 14B 

G3/14 


N74- 11286' 

Unclas 

15491 



R.P.I. TECHNICAL REPORT MP-32 


GRADIENT ESTIMATES FROM STEREO MEASUREMENTS 
FOR A MARTIAN VEHICLE 

by 

William J, Pfeifer 

National Aeronautics .and Space 
Administration 

Grant NGL 33-018-091 


A project submitted to the Graduate 
Faculty of Rensselaer Polytechnic Institute 
in partial fulfillment of the 
requirements for the degree of 

MASTER OF ENGINEERING 


School of Engineering 
Rensselaer Polytechnic Institute 
May, 1973 


1 ' 



TABLE OF CONTENTS 


Page 

LIST OF FIGURES V-vi 

LIST OF SYMBOLS Vi-ix 

ACKNOWLEDGEMENT . . .......... x 

ABSTRACT . 

1 . INTRODUCTION ! 

2. METHOD OF APPROACH 2 

A. Transf ormation of Coordinate ' Systems .•••••«» 2 

V 

V. Stereo Angles ............... 2 

2. Stereo Range ................ 4 

3. Non-stereo ................. 6 

B. Determinations of Slopes and Gradients ....... 6 

3. ESTIMATION OF SLOPES AND THEIR COVARIANCES 9 

A. Least Square Estimate of the Slopes 9 

B. Perturbation of the Variables 9 

1 . Stereo Angles ............ ...10 

2. Stereo Range .......... .10 

C. The Covariance Matrix of the Variables .......12 

1 . Stereo Angles ............. ,.12 

2. Stereo Range • ..........12 

D. Covariance Matrix of the Slopes ...........13 

E. Variance of the Gradient ...14 

F. Determination of the Gradient .......... ..16 

4. DISCUSSION OF NUMERICAL RESULTS 16 

A. Stereo Angles System ................17 

B, Stereo Range System ...........23 

iii 

PRECEDING PAGE BLANK NOT FILMED 



Page 

C. Comparisons of Four Point Fit with Three Point Fit ...32 

D* Standard Deviations in Vehicle System Coordinate 

Estimates (h^a’ ,b») . . . , , , , . . . , . . . . ,37 

5. CONCLUSIONS . ... . . . . 50 

6 . REFERENCES 53 

APPENDIX 

A, Derivation of the Perturbation Equations ...... 54 

B, Derivation of the Covariance Matrix of the Variables 56 

C, Derivation of the Slope Covariances ........ 57 


iv 



LIST OF FIGURES 


Page 

Figure 1 Stereo Angles System Coordinates ........... 3 

Figure 2 Stereo Range System Coordinates ........... 5 

Figure 3 Non-stereo System Coordinates .... 7 

Figure 4 Relative In-Path Slopes ..18 

Figure 5 Stereo Angles System: Standard Deviation in Gradient 

Versus Distance from Vehicle on Flat Terrain with 
Relative Slope = 0 . , . . .........20 

Figure 6 Stereo Angles System: Standard Deviation in Gradient 
Versus Relative In-Path Slope for Terrain at 4 m 
with Data Point Spacing = 0.6 m .. .,..22 

Figure 7 Stereo Angles System: Standard Deviation in Gradient 
Versus Relative In-Path Slope for Terrain at 20 m 
with Data Point Spacing =1,2m ...... 24 

Figure 8 Stereo Angles System: Standard Deviation in Gradient 
Versus Relative Cross-Path Slope for Terrain at 4 
and 20 Meters .....*....,,........25 

Figure 9 Stereo Range System: Standard Deviation in Gradient 
Versus Terrain Distance from Vehicle with Relative 
Slope = 0* 27 

Figure 10 Stereo Range System: Standard Deviation: in Gradient 
Versus Relative In-Path Slope for Terrain at 4 m 
with Point Spacing = G.6 m „ .. .. ... ... ...29 

Figure 11 Stereo Range System: Standard Deviation in Gradient 
Versus Relative In-Path Slope for Terrain at '20 m 
with Point Spacing =1. 2m. ........... ..30 

• 

Figure 12 Stereo Bang© System: Standard Deviation in Gradient 
Versus Relative Cross-Path Slope for terrain at 
4 and 20 Meters 31 

Figure 13 Stereo Angles System: Standard Deviation in Gradient 
Versus Relative In-Path Slope at 4 Meters with Point 
Spacing * 0*6 m for 3 and 4 Point Planes 33 

Figure 14 Stereo Angles System: Standard Deviation in Gradient 
Versus Relative In— Path Slope at 20 Meters with Point 
Spacing = 1.2 m for 3 and 4 Point Planes , 34 


v 



Page 

Figure 15 Stereo Range System: Standard Deviation in Gradient 
Versus Relative In— Path Slope at 4 Meters with Point 
Spacing = 0.6m for 3 and 4 Point Planes ...... 35 

Figure 16 Stereo Range System: Standard Deviation in Gradient 
Versus Relative In-Path Slope at 20 Meters with 
Point Spacing = 1.2m for 3 and 4 Point Planes ... 36 

Figure 17 Stereo Angles System: Standard Deviation in Height 
Coordinate Ch') Versus Distance from Vehicle for 
Flat Terrain with h*=0 .............. 38 

Figure 18 Stereo Angles System: Standard Deviation in Height 
Coordinate Versus Distance from Vehicle for Flat 
Terrain with h' = 0. 39 

Figure 19 Stereo Angles System: Standard Deviation in Coordinate 
b* Versus Distance from Vehicle for Flat Terrain « * 
with h* = 0 . . . 40 

Figure 20 Stereo Angles System: Standard Deviation in Height 
. Coordinate Versus Distance from Vehicle for Various 
Values of h 1 ................... 42 

Figure 21 Stereo Range System: Standard Deviation in Height 
Coordinate Versus Distance from Vehicle for Flat 
Terrain with h t =0.. ........ 43 

Figure 22 Stereo Range System: Standard Deviation in a’ and b 1 
"''Coordinates Versus Distance from Vehicle for Flat 

Terrain with h* =0... ....... ...... 44 

Figure 23 Stereo Range System: Standard Deviation in h r and b* 
Coordinates Versus Distance from Vehicle for Various 
Values of h 1 ..... ......... 45 

Figure 24 Non— stereo System: Standard Deviation in Height 
Coordinate Versus Distance from Vehicle for Flat 
Terrain with h* = 0 . ...... ......... 47 

Figure 25 Non-stereo System: Standard Deviation in b 1 Coordinate 
Versus Distance from Vehicle for Flat Terrain 

with h* = 0 . . . ......... . 48 

Figure 26 Hon-stereo System: Standard Deviation in Height 

Coordinate Versus Distance from Vehicle for Various 
Values of h' ................... 49 

Table Comparison of Stereo and Non-stereo Measurements 

Using Four Point Plane Fitting .......... 51 

vi 



LIST OF, SYMBOLS 


Q> 

e 

T 

U 

h' 

a' 

b‘ 

L 

h 

a 

b 

C 

P 

B 

f 

M 

N 

K 

R 

P 

J 

Q 


sg 



Elevation angle measured a known vertical distance from the 
top of the sensor mast 

Elevation angle measured at the top of the sensor mast 

Azimuth angle 

Top of sensor mast 

Terrain point , 

Vertical coordinate fixed to vehicle 

} 

Horizontal coordinate fixed to vehicle perpendicular to 
direction of motion 

Horizontal coordinate fixed to vehicle perpendicular to a* & h* 
Separation distance between transmitter and receiver (vertical) 
Vertical coordinate in non-rotating system (local vertical) 
Horizontal coordinate in non-rotating system perpendicular to 
the vehicle heading and h 

Horizontal coordinate in non-rotating system (vehicle heading) 
Matrix transformation for vehicle roll 
Roll angle 

Matrix transformation for vehicle pitch 
Pitch angle 

Measurement in the stereo range system 
Measurement in the stereo range system 
Measurement in the stere j ran^e system 
Range from transmitter to terrain point 

Range from terrain point to receiver L meters Below top of mast 
Horizontal separation distance between transmitter and receiver 

l 

Range from terrain point to receiver J meters from top of mast 
(horizontal distance=J) 

Cross-path slope 
In-path slope 

Parameter in equation for plane 

Gradient of terrain 
th 

Height of i point in modeled plane 

j- 

Actual measured height of i point 


vii 



LIST OF SYMBOLS 



O"0 

cr L 

Oj 

r A 

<T* 

o> 

Oa 

Gr 

fi 

(Tk 


Actual measured value of a for i point 

til 

Actual measured value of b for i point 
Matrix of actual a and b measured coordinates 
Least square estimate of slopes 
A perturbation 

Matrix relating perturbations in p and ^ with those in h, a and b 
Stereo angles matrix relating perturbations in c( t and L 

with those in h, a andb 

Stereo range matrix relating perturbations in M, N, K, L and J 
with those in h, a and b 

Non-stereo system matrix relating perturbations in R, f ,^and 
with those in h, a and, b 
Covariance matrix of the variables 
Expected value 

Covariance matrix of the variables for stereo angles 
Covariance matrix of the variables for stereo range 
Matrix relating the slope estimate with the perturbations 
in h and A 

Derivative of gradient 
Standard deviation in gradient 

Standard deviation in roll angle 0 

Standard deviation in pitch angle‘s 

Standard deviation in separation distance L 

Standard deviation in separation distance J 

Standard deviation in an angular measurement 
Standard deviation in©< 

Standard deviation in P 
Standard deviation in © 

Standard deviation in a range measurement R 
Standard deviation in range measurement M 
Standard deviation in range measurement N 
Standard deviation in range measurement K 


viii 



LIST OF SYMBOLS 


c 

- * 


b 


<v 

(Tf 


Data point spacing (meters) 

Distance from vehicle (meters) 

Standard deviation in h* coordinate calculation 

Standard deviation in a' coordinate calculation 

Standard deviation in b* coordinate calculation 

Bar - denotes actual value (assumed errorless) 



ix 



acehowledgeheht 

. \ ' ■' : ' '' ■' " 

The author would like to thank the National Aeronautics 

and Space Administration for sponsoring this research. 

Dan Palumbo and Glen Herb provided very helpful information 
on laser rangefinders and scanning systems. Special thanks are extended 
to Paul Burger who developed much of the stochastic estimating method. 

Most of all the author wishes to express his gratitute to 
Dr. C. N. Shen for his encouragement," helpful criticism and patient 
guidance during this project. 


x 



ABSTRACT 


The R.P.I. Martian Roving Vehicle requires an autonomous 
obstacle detection and path selection system. A laser rangefinder 
will be used to determine the locations of a number of discrete 
points at distances of- 3 to 30 meters from the vehicle. The system 
might measure angles, ranges or a combination of both types of 
measurements. 

The slope of the terrain is very important in the selection 
of a navigable path. Four, or more, terrain data points may be used 
to calculate a stochastic estimate of the gradient of a small area 
of the Martian surface in the vicinity of the points. The accuracy 
of this estimate is influenced by the point locations as well as 
the measurement errors. 

The accuracy of stochastic gradient estimates is analyzed 
for two stereo- measurement systems, one measuring angles, and the 
other ranges. These are compared with a non-stereo system using a 
combination of measurements. The accuracy of the discrete point 
location calculations is also discussed. 

The non-stereo system is shown to be the most compatible 
with present laser rangefinder technology. 
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PART 1 ‘ 

INTRODUCTION 

• "V ■ . 

\v 

The roundtrip communication time from Mars to Earth is over 
40 minutes# Therefore, the R.P.I* Martian vehicle f s terrain modeling 
and path selection system roust he autonomous# 

Two points along the path of the vehicle determine an in- 
path slope, while those across the path determine a cross-path slope# 
In the 3 to 30 meter range, hov/ever, inaccuracy in measurement can 
introduce very large errors in the computed slopes, which are the 
main factors in path selections. There are some threshold values for 
these slopes and heights above which a change of path is required* 

One system discussed in this report, referred to as stereo 
angles, uses three angular measurements in elevation and azimuth to 
locate a terrain point* Another system, called stereo range, uses 
three range measurements* These two systems are compared v/ith a non- 
stereo system which uses one range , and two angular measurements in 
elevation and azimuth. ( 2 1 

! A stochastic estimate of the gradient of the terrain may 

be ( computed using four or more terrain measurement points*. The ac- 
curacy of this estimate depends on the terrain point locations and 
on the measurement errors. Since the R.P, I. vehicle will probably 
use a laser system to measure the terrain point coordinates, the 
accuracy requirements can be compared with the limits of present 
laser rangefinder technology. 1*1 
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PART 2 ’ 


METHOD OF APPROACH 

The gradients or maximum slopes of the terrain in front of 
the vehicle are determined by measuring four or more points on the 
Martian surface. 

A. Transformation of Coordinate Systems ' 

1 . Stereo Angles 

The elevation angles oC and @ , and the azimuthal angle 0 
are measured with respect to the coordinate system h*, a*, bl fixed 
to the vehicle as shown in Figure 1. A laser is located at point T 
which is 3 meters in height. The elevation angle p of the transmitted 
light beam is measured at T from the horizon to the terrain point U. 
The elevation angle o(, of the received beam is measured at a point 
L meters from the top of the mast. Some type of scanning detector 
is assumed in the measurement of the angled . The angle 6 is the 
azimuthal angle of the transmitted beam. 


From the geometry, with n sensor mast height of 3 meters, 
the terrain point coordinates h», a*, b» are found in terms of «* , 
P , B , and L. 


h» 


a* 


3- » tan t 

(tanP -tan fi<) 

L sin Q 
(tan (i -tan *< ) 


Oa) 

(1b) 


b* = L CQ3 3 (1c) 

( tan £> -tan ) 

The h 1 , a*, b* coordinate system which is fixed to the vehicle 


2 



3 


o<^ ft - Elevation Angles 



Figure 1 Stereo Angles System Coordinates 


A 


may be transformed, to a reference system, h, a, b formed by the local 
vertical, the vehicle heading and an axis perpendicular to both. It 
is assumed that the vehicle rolls with an angle and pitches with an 
angle J about the reference frame, h, a, b. In matrix form this trans- 
formation is:^^ 


where 


and 



a = C(^) B(f ) 
b 



cos f -sin p 
C(jO «s sln^ cosf 
0 0 


cos 

B(^ ) = 0 

-sin"^ 

Stereo Range 


0 

1 

0 



(2a) 


(2b) 


(2c) 


The quantities M,H and K are measured with respect to the 
coordinate system h*, a-', b* which is fixed to the vehicle as in Fig. 2 
The measurement M is twice the range to the terrain point U from the 
transmitter and receiver at T on top of the sensor mast. 


M = 2 R * S (3a) 

The measurement IT is the sura of the ranges from the transmitter at T 
to the terrain point V and from this point back to, a receiver at a 
vertical distance L meters from the transmitter. 


N = R 4 P (3b) 

The measurement K is the sum of the ranges from the transmitter at T 
to the terrain point U and from this point back to another receiver 
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T Measurements: M = 2 R 



Figure .2 Stereo Range System Coordinates 
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at a horizontal distance J meters froih the transmitter* 

K = E + Q- (3c) 

From the geometry the coordinates of the terrain points 
are found in terms of M,N,K,L and J. 



h' = 3 - R sin (5a) 
a* = R cos(* sin 9 , i (5b) 

b* = R cos@ cos0 (5c) 

Again the transformation to the non-rotating coordinate system is 
given by equation (2) . 


B. Determinations of Slones and Gradients 

i n !..»■■> . t »' I i H . il.l t win ii i mmm i ,m i ■ ■ i i i 

A number of the measurement points from a small area of the 
Martian surface, perhaps 1 meter by 1 meter, can be used to determine 
a plane in space. This may be written as 
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Figure 3 Non-stereo System Coordinates 
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h = ax 1 + bx 2 + x 3 (6) 

where the parameters Xj and x 2 are constants. Equation (6) is 
differentiated to give 

\ } h Jti 

h = -r— da + -r-r- db = x, da + x„db 

da d b 1 2 


where 


*1 - = cross-path slope 

3 h 

x 2 = -jt" = m-path slope 
The gradient of the plane is defined as 


1.5,6] 


■ -• Sg = (x^ + x 2 ) r ^ 

The gradient is the maximum slope of the terrain plane rep- 
resenting the local terrain feature. If the magnitude of the gradient 
is less than some critical value, probably about 25 degrees, the terrain 
will be considered passable. 

By using the measurement points to locate a plane, Equation 
(6) nay be written as 


h. = a.x. + b.x„ + x 
i i 1 12 3 


( 8 ) 


where h^, a^ and b^ can be found either froznoi,(^ , © and L for a stereo 
angles system using Equations (1) and (2), from K,H,K,L and J for a 
stereo range system using Equations (4) and (2) or from R, O' and & 
for the non-stereo system using Equations (5) and (2). 

Three points theoretically determine a plane. To obtain greater 


accuracy, however, four or even six points can be used to determine 
the gradient. A number of adjacent planes, each covering a small area, 
nay be modeled to construct a complete picture of the terrain in front 
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of tho vehicle* 


PART 3 ' 

. ESTIMATION OF SLOPES AND THEIR COVARIANCES 

This section includes the solutions of a least squares error 
estimate and the covariance matrices when n>3. 

A. Least Square Estimate of the Slones 

r 

A least square error estinate can be performed minimizing 

n A 

^ } <«> 
assuming = a ± and b i = b^ are true in Equation (8)* The value h ± 
is the actual measured height of the terrain point and ItL is the cor- 
responding height in the modeled plane. 

Equation (8) is written in matrix form as 

h = A x (10) 


a i b , 1 

a 2 b 2 ' 


a b 1 
n n 


3 n=4 or 6 * 


The matrix x must be determined in such a way that Equation (9) 

♦ 

is minimized* Through use of the Gram— Schmidt orthogonalization procedure 

f 7 J 

the least sguare estimate of x becomes * 

rn 

A -TU — * X 

X = (A a A) 'Ah (11) 

B. Perturbation of the Variables 

The matrix A in the least square estimate above is assumed 
to be completely deterministic.^ The determination of h, a, and b 
involves errors due to uncertainties in the measured angles or ranges. 
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The symbol $ is used to denote a perturbation. 

1 • Stereo Angles 

Then 3 b* 5 a and 3 b can be found in terms of Si B , . 

3*, 3e and 3 L. From Equations (1) and (2) the perturbations in h, a 

2 

and b are determined as follows: 

5h 


3b 


= D(h 


a', b fy 

m <m 


+ C(jf ) B( J ) G a (o<,(>,© t L) 


$ c< 

5® 

3 L 


(12a) 


where 


G (of ,0 , ©,L) = 


L tan? sec c< 
(tan(* -tano< ) 2 

L sec 2 e< sin© 

2 

(tan() -tan o( ) 

2 

L sec o< cos© 

K ■ i 

( tan (> -tan «( ) 2 


L tanO 


sec 


tan i 


( tan P -tan ®< ) ‘ 

L sec 2 P sinP 
(tan /) -tane<) ‘ 
2 

L sec ft cos& 


Xi c os & 


(tanO -tan cO 
sin © 


(*tan(^ -tant-f ) ( tan -tan ) 

-L sin£> cos © 


V 

( tan -tan •< ) (tan^ -tanc<) (tan ^ -tan o( ) 


Cl 2b) 


The derivation of the matrix D is shown in Appendix A. 

2. Stereo Range 

The quantities 3h, £a, and£b can be found in terms 
» 3*‘> 3k, Vk, and^J. From Equations (2) and (4) the perturbations 
in h, a and b are determined as follows: 

S h 


3 a 

3b 


= D(h*. a«, b»,0 ) 




+ C( ^ )B(| )G r (K,H } K,L,J) 


$ M 

u 

Sk 
Sl 
3 j 


(13a) 



where . 


G r (M,N,K,L,J) = 


-K 

2L 

K 

2J 


2N-M 

2L 


2 " 2L^ 


g 


31 


-'32 


M-2K 

2J 


*33 


g, 


34 


and 


3 31 


g 


32 


S 33 “ 


2L - - k2 ( m - k > + n 2 (n-h) 

2 2 2 2J 2 2L 2 

2b* 


2N-H (2ir^-3N 2 ?-I+I^M 2 ) 

2 

__2 2l£ 

2b» 

2K-M (2K 3 -3K 2 JI+rai 2 ) 

2 

2 2J 

2b* 

b 2 

N(N-M) L 



For the nOii-stereo system the matrix G becomes 

6 n5 «,?,©) = 


oj 


1 K(H-K) 
_ o 

2 


2J 


g 


35 


(~sin(i ) (-Rcosp ) 0 

(cos^sin®) (-Esinf* sinO ) (RcosPcos©) 
(co.s^ cos&) ( -Esin P cos©) (~Hcos(J sin£ ) 


(13b) 


04 ) 
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E(}*() 2 0 0 0 

o e( 5/J) 2 o o 

o o e(& 6) 2 o 

0 0 0 E(ju 2 

i’he variances of h, a and b are the diagonal elements of 

the matri:; Y in Equation (15). The standard deviation' of each of these 

quantities is the square root of its variance.. From Equations (15) and 

* 

(16) the standard deviations of h, a and b can be computed in terms 
of those of^j'J > , P ,^and L for each point. These are known 
quantities which depend on the accuracy of the measuring devices. 

2. Stereo Range System 

If, Sft 5*^ » S 5 N, $ K, 5 L and £ J are uncorrelated t^then 
by the same method used to derive Equation (16) the following is 




obtained. 
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Y = D 
r 




v(&}Y 


+ C B G 


e(Sh)‘ 

0 

0 

0 

0 


0 0 

e(Sn ) 2 o 
o e(£k) 2 
o o 

0 0 


.T 


0 

0 

0 


0 

0 

0 

0 


T T T 

a b c 

r 


E(£l) 2 

0 E<Sj) 2 I (17) 
The standard deviations of h, a and b can be computed in 
terms of those of ff , ^ , M, N, K, L,and J for each point. Equations 
(16) and (17) include the matrix G which involves all the measured >. 
quantities. Therefore, the standard deviations in h, a and b depend on 
the locations of the data points in relation to the vehicle as well as 
on the accuracies of these measurements. 

D. . Covariance - Matrix of the Slopes 

Equation (10) may be rewritten to include the perturbations 
in h, A and x. 

h = P ;. x ' (18a) 

h = h +Sh (18b) 

A = A + Sa (18c) 

X sr X + $ x (1 8d) 

The original equation, (10), is subtracted from (16a) to 

obtain 

$ h — A&x + Sax (19) 

The estimate of the slope is 

S x = F( S h- S A x) (20) 
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Equations (19) and (20) are' compared to Eq. (10) .leading to 
the result that 

F •■(A 1 '! ) -1 A 1 (21) 

The covariance matrix of the slopes is determined in Appendix C 


as 


E(Sx$x T ) = F^E(JhSh T ) - EtfAxfr 1 ) - E(£h(SAx) T ) + E(JAx(SAx) T )^F T (22) 


where 


s?r 

4% 

& 

IS 

V 

£ax = 

m 

(^a 1 x 1 +ib 1 x 2 ) 

(Ja 2 v 

n 


(y-k 

JET* # • • 

2 

1 


♦ ■» 

« » 

-* • * 

(da x.+ f b x ) 
n 1 n 2 


(23) 


The matrix A is in terras of a and b, Therefore, jh and Ja 
can be expressed as functions of ^ y » ^ $^and £ L for the stereo 
angles system, using Eq, (12). Thus Eq. (22) can be evaluated as 
shown in Appendix C. 


For the stereo range system ^h and Ja are expressed as 
functions of JMs.S M, $K, ^ E, $ L and^J using Equation (13). Then 
the covariance matrix of the slopes is determined in Equation (22). 

From Equations (21) and (22) it is seen that the covariance 
matrix of the slopes also depends on the matrix A which is determined 
by the measured “locations of the points. As a result the estimate of 
the gradient is expected to be influenced by the data point spacing, 

E. Variance of the Gradient 

The symbol 0" denotes the standard deviation of the gradient 
sg 

Sg. Equation (7) is differentiated to get 

dSg = (x^ + Xg)** 5 " Xj dx^ + (Xj +x^) 2 x 2 dx 2 (24) 
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From Equation (24) the variance of the gradient becomes 


2 


2 - 2 . 

* X 1 + X 2 ^ 


x vj ; 

(x^ 2 + x 2 2 ) (x^ 2 + x 2 2 ) 


Wher,> O' 2 = e[(S^) 2 1 

( Tx 2 2 = 

O'*,*/ ” *C i *i S *2 ) l 

Those covariances are found from Equation (22). 

The value of is an estimate of the accuracy of the estima— 
ion of the gradient. If a normal distribution is assumed, then the true 
value of the random variable, in this case the gradient, will lie within 
one standard deviation of the estimated value 68% of the tlme.^ 9 \?he 
actual gradient will be within two standard deviations of the estimate 
95% of the time. 

_ o ^ o 

For example, if the estimate of gradient is 25 and N s 3 

sg 

then it is only a 68% probability that the actual gradient of the 

0 o 

terrain is between 22 and 28 . If the t stimated gradient is near the 

maximum passable value, the magnitude of (J” , is very important in 

* [ 

the operation of the path selection algorithm* 

The slope covariances depend on the data point locations in 
relation to the vehicle and to each other* The standard deviation of 
gradient (T depends on the slope covariances, so<T will also be a 

og . Sg 

function of the data point locations. Varying the spacing of these 

points changes the covariance matrix and therefore affects ^ * 

eg 
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F. Determination of the Gradient 1 

Once the value of the cross-path and in-path slopes are 
determined from the least squares estimate, the gradient can be 
calculated from Eq. (7). The vehicle uses the estimate of gradient 
in its path selection algorithm^ ^ to select a safe course. 

PART 4 

1 

DISCUSSION OF NUMERICAL RESULTS 


It is assumed that the vehicle will have some type of scan-* - 

(1 1 j 

nlng apparatus to let the laser beam arrive at various terrain points. 
The h', a' and b’ coordinates will be computed either by stereo angles 
or stereo ranges and then transformed to the non-rotating coordinate 
system h, a and b as described in section 2A. 

Four or more data points are used to model a plane and to 
calculate a least squares estimate of the gradient as outlined in Part 3. 
The accuracy of this estimate depends on the magnitudes of the cross- 
path and in-path slopes, the distance of the data points from the 


vehicle, the spacing between the points and the roll and pitch angles. 

It is assumed that the measurements jt and ^ will provide 

standard deviations and of about 1 .^^By assuming reasonable 

data point spacing, previous research^^has shown that <J" is approx- 

sg 

imately 30° if ftp =(J^ =1 ♦ This value for the standard deviation in 

co 

gradient is unacceptable. It is desired that \J be less than 2 or 3 

sg 

for terrain within the 3 to 30 meter range. 

If a rapid-scan laser is used, the effect of 6^and(T^can be 
reduced. If the time between the measurement of adjacent data points 
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is on the order of milli-seconde, as it would be with a rapid-scan 
laser, then the data points are measured almost instantaneously compared 
to the vehicle motion which is on the order of seconds. All four points 
will then have the same values of t> and^, The points will retain their 
relative position when they are transformed to the non-rotating coor- 
dinate system by Eq. (2)* Therefore, the planes can be modeled in the 
h 1 , a 1 , b f coordinate system and then transformed to the h,a, b coor- 
dinate system. By letting^ 0 in Equations (12) and (16), or (13) 

and (17), then, the result is that h* = h, a* = a, and b' = b in those 
equations. The additive effect of the standard deviation in i and J 
will be about 1° because with the rapid-scan laser the effects of 

and (Pc can be added to the factor O'" from the modeled plane afterward 
7 . sg 

since the entire plane is transferred at the same time to the non-rotating 

coordinate system* As a result, in the calculation of <T„ the substitution 

sg 

<Sp = 0° is made in Equations (16) and (17). 

© 

The maximum magnitude of navigable slope is assumed to be 25 . 
Relative slopes betv/een +50° and -50° are possibly navigable as shown 
in Figure 4. The following analysis considers relative slopes within 
these limits. •, 

9 

1. Stereo Angles System 

k 

It is assumed that the scanning mechanism can provide any 
desired data point spacing at distances from 3 to 30 meters from the 
from the vehicle* The data point spacing also depends on terrain ir- 
regularities, however, a flat terrain is assumed at the start. 

The distance L in Fig, 1 is assumed to be 1 .0 meter. This is 
the most reasonable value for a 3 meter sensor mast height, A larger 
value of L can give smaller errors in measurement. But, as L is 




increased beyond one meter, the vehicle's ability to observe negative 
slopes is decreased. Also, if the receiver is lower on the mast there 
is more chance that the reflected laser beam will be blocked by other 
vehicle equipment, 1* 

The standard deviations Otf, tfj^and (5© are set equal to 1 1 , 

a reasonable value using presently available equipment .^^Then the 

data point spacing and the standard deviation (Tg are varied for points 

in the 3 to 30 meter range. In order to determine ^ , the standard 

deviations of the measured values and the data point coordinates are 

obtained from Eqs. (12), (16), (21), (23) and (25). 

Figure 5 shows a plot of standard deviation in gradient (T 

sg 

£ o 

vs. distance, b , from the vehicle for flat terrain with 0 relative 

slope having =0,0 Ira. The dotted lines are for (T=0. 005m, Clearly 
^ as 311 important effect on 0^ for the stereo angles system, 
especially at close range where decreasing 0T from 0.01m to 0.005m 

„ -- U 

reduces the value of O' by fifty percent. As expected, larger data 

sg ■ 

point spacing gives smaller values for the standard deviation in 
gradient. At close range, data point spacing of 0.66m or less is 
required because 0.66 meters is the width of the widest iravigable 
crevice. 4 meters distance from the vehicle, a spacing of 0.6m 
gives (Qg =3 and 1.55* v/ith(T^= 0.01m and 0.005m respectively. Since 
3- s designed to be less than 2°, it appears thatO" L must be about 
6.005 meter or less. 

The standard deviation in the distance L ( (T ) may result 

L 

from changes in the sensor mast, expansion or contraction due to v 
temperature changes, or from uncertainties caused by the laser 




21 


transmitter and receiver. 

At ranges of 20 to 30 meters, a data point spacing of 1.2 m 

will be. i adequate to obtain the gradient of the terrain in front of 

the vehicle. This terrain would probably be remeasured when the vehicle 

moves closer to it. In Fig. 4, at 30 meters with 1.2 meter data point 

spacing, the computed results are that the standard deviations for 

gradient CT are 2.2° and 1.8 for (T = 0.01m and Cf = 0.005m respectively, 
Sg b L 

At that range both values of the quantity^ may be acceptable* 

sg 

Figure 6 shows the plot of (f^ versus relative in-path slope 

© o 

from -27 to +50 at a distance of 4 meters from the vehicle. The 

© 

vehicle connot measure negative in-path slopes of more than -27 because 

MM 

the terrain obstructs the line of sight. The cross-path slope, x , is 

o 

set to 0 in Equations (19), (20), (22) and (25). The in-path slope, 

— o o _ _ r - 

x , varies from -27 to +50 . The standard deviations (T and vJ are 
^ Jui A 

varied in Eq.(16) and the results used in Eqs. (22)and (25) to cal- 
culate the quantity (J” . In Fig. 6 the data point spacing is 0.6 meter 

sg 

as required at the 4 meter distance. The stereo angles system estimate 


of the standard deviation in gradient is quite sensitive to the 

sg 

relative in-path slope. 

# 

By reducing the angular standard deviation, d* = tfp = (T© , 
to 6 arc-seconds and maintaining the transmitter-receiver separation 
distance standard deviation at 0.01m, the standard deviation in 

if 

gradient (T is not significantly reduced. If the quantity (f is set 

Sg Lt 

equal to zero and the quantity is set equal to 1 * then ^ has a 

0 © ... 

maximum value of 2.5 for relative in-path slope of +50 , Increasing 

the magnitude of (T t to 0.001m has a small effect on the value of <T . 

b s£ 
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Reducing the angular standard deviation to less than 1 1 will 

require additional and more bulky equipment . Accuracy as low as 6 arc- 

seconds may not be practical but would improve the resulting (T i f(T^ 

sg L 

is about 0*001 meter* 

Figure 7 shows the standard deviation in gradient (T vs. 

sg 

0 ' ■ O 

relative in-path slope from -6 to +50 at a distance' of 20 meters from 

the vehicle. The terrain obstructs the view of the in-path slopes for 

o 

more than -6 relative slopes at 20 meters. For this graph the data 

point spacing is 1.2 meters. At 20 meters the standard deviationCT 

increases drastically with increasing relative in-path slope. To obtain 

the quantity less than 3 for all relative in-path slopes up to 50^, 

the standard deviations^ should be less than 0.001m and 07 less than 

b A 

6”. Larger values of either standard deviation have the results of (T 

sg 

being much greater than 3 for nearly all positive relative in— path 
slopes* 

Figure 8 shows the standard deviation in gradient vs. relative 

o o 

cross-path slopes from 0 to +50 for distances of 4 and 20 meters with 

data point spacings of 0.6 meters and 1*2 meters respectively. Cross- 

path slopes from 0 to -50 will give the same results because of the 

symmetry of the system. If the standard deviations KT =1 1 and = 0.005m, 

or less, the value of ^ is less than 2,5^ at both distances. 

sg 

2. Stereo Range System 

As in the stereo angles system, it is assumed that the 
rapid scan transmitter at T (Fig. 2) can provide the desired data point 
spacing for flat terrain. The separation distances L and J are both 
assumed to be equal to one meter. This is the most reasonable value 
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Figure 7 Stereo Angles System: Standard Deviation in Gradient Versus 
Relative In-Path Slope for Terrain at 20 Meters with Data Point Spacing 1.2m 
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Figure 8 Stereo Angles System: Standard Deviation in Gradient Versus 
Relative Cross-Path Slope for Terrain at 4 and 20 Meters 



for the vertical separation distance L for the reasons stated previously 
The one meter value is also reasonable for the horizontal separation 
distance J because a larger J trill require a. more massive support. 

It is assumed that the standard deviations in L and J are 
equal since the system configuration is somewhat symmetric in the 
horizontal and vertical directions. These uncertainties may result 
from changes in the support dimensions and from the laser transmitter 


and its 3 receivers. 


(2,nl 


The range standard deviations (T,j, anrf are 

assumed equal to 2 These standard deviations and the data point 
coordinates are employed to calculate the quantity in Equations 

Bg 


(13), (17), (21) and (25). 

Figure 9 shows Q~ vs* distance, b , from the vehicle for 
sg 

o 

flat terrain v/ith relative slopes = 0 ,and O.OOItrw The solid lines 

show the quantity (T when the value of^""~(f T is 0.01m and the dotted 

sg ho 

lines v/henQ~ = (T t is 0.005m. The standard deviations in gradient (T 
for the stereo range system are not sensitive to the standard deviations 
in separation distances 0^ and By reducing the quantity^ from 
0.01m to 0.005 n at a distance of 4 meters with point spacing of 0.6m 

and range standard deviation 0^ = 0.001m, the value of ()~ decraeses 

a o 

from 2.3 down to 1.7 . 

As expected, larger data point spacing results in smaller 
standard deviation in gradient. At close range a 0.6m point spacing 
results in the quantity V sg = 2.3° when the values of ^ and^ are 
0 ;001m and 0.01m respectively. To obtain standard deviation in gradient 
less than 2°, 0^ must be less than probably about 0.005meter. 
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At longer range, data point spacing should be increased to a value 

greater than one meter. For example, at 20 meters either the spacing 

must be greater than 1.2 meters or the range standard deviation (T R must 

be reduced below 0.001m in order to obtain a value of Q - to be less 

_ eg 


than 2 degrees. 

Figure 10 is a plot of the standard deviation in gradient vs. 
relative in— path slope at a distance of 4 meters from the vehicle 

having data point spacing of 0.6m. The range of relative in-path slopes 

o o 

is from -27 to +50 for the same reasons as for the stereo angles 

system. In this case<C decreases as relative in-path slope increases 

sg 

to +50 .From the figure it is concluded that to obtain the value of^J' 

IJ 

to be less than 2 for most relative in-path slopes, the magnitude of 

AT must be O.OOIn or less and the magnitude of must be 0.005m or 
^ 32 b 

less* 


In Figure 1 1 the standard deviation in gradient is plotted 
against relative in-path slopes at a distance of 20 meters with data 

point spacing of 1*2 meters, in this graph the value of the quantity 

D 

rf increases slightly as relative in-path slope increases to +50 . To 
u sg 

obtain a maximum standard deviation M of 2 v/hen the value ofQj T is 

sg Lt 

0*005m, the range standard deviation <r K must be about 0. 0005m. 

Figure 12 shows the standard deviation in gradient versus 

0 ^ 

relative cross— path slopes from 0 to 50 at 4 and 20 meters with data 
point spacings of 0.6m and 1 *2m respectively* The quantity is 0.001m 
and is 0.01m and 0.005m. Again the value of ^ R raust be less than 0.001m 
in order to obtain relatively small standard deviation in gradient* 
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Figure 11 Stereo Range System: Standard Deviation in Gradient Versus 


Relative In-Path Slope for Terrain at 20m with Point Spacing = 1.2m 






3* Comparison 8- of the Four Poijit Fit with a Three Point Fit 

The gradiont of the terrain may be estimated by modeling 
a plane containing three data points. Since 3 points determine a plane 
the sum in Eq, (9) reduces to zero. From the three point plane the 
cross-path slope, , and the in-path slope, x^, and their covariances 
are calculated in Eqs. (11) and (22). These results are used in Eq.(25) 
to compute a standard deviation in gradient (J"* • 

Comparisons of the accuracy of the gradient estimate for 
the three and four point schemes are shown in Figures 13-16. Fig. 13 
shows the quantity ^ vs. relative in-path. slope at 4 meters for the 
stereo angles system with point spacing of 0.6m. For relative in-path 
slopes less than about 10 the 4 point fit is much more accurate* xhis 

is important since over much of its course the vehicle will be measuring 

o o 

terrain with relative slope in the -20 to +20 range. 

The next graph (Fig. 14) shov/s QT _ plotted against relative 
in-path slope at 20 meters distance with point spacing equal to l*2ra. 

In this case the four point stochastic fit is better than the 3 point 

method for all relative slopes. 

Figures 16 antt 16 show the comparison for the stereo range 
System at 4 and 20 meters respectively* At close range a 4 point fit 
is much more accurate for positive relative in-path slopes. At 20 ra 
the four point stochastic estimate is considerably more accurate than 
the three point calculation for all relative in-path slopes* 

Since the calculation in the 3 point case is nearly as 
complicated as the four point case and the resulting estimate of 
gradient is much less accurate with a 3 point system^ the four point 
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Figure 13 Stereo Angles System: Standard Deviation in Gradient Versus 
Relative In-Path Slope at 4 Meters with Point Spacing •» 0.6 
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Figure 15 Stereo Range System: Standard Deviation in Gradient Versus 

Relative In-Path Slope at 4 meters with Point Spacing = 0*6n 
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stochastic estimate is clearly recommended. 

4. Standard Deviations in h’,a*and b» 

. . The standard deviations in M, a* and bimay be determined from 

Eq. (15). Since these uncertainties are involved in the estimate of 
the gradient a closer look at these parameters nay explain some of 
the results previously discussed. It is also possible that the path 

/ • l 

selection algorithm may take height differences between data points 
into account/' ^ 

The standard deviation in the coordinate h* is plotted against 
distance from the vehicle for the stereo angles system in Figure 17. 

The value of L is one meter and its standard deviation is 0.01m. The 
terrain assumed is flat with zero height and no relative slope. Since 
the critical height for path selection may be about .45 meter the 
standard deviation in the height measurement should be no more than 
a few centimeters. From the figure it is obvious that the angle standard 
deviation should be about 1 * , Reducing the quantity to 6" give little 

■ri 

improvement in the accuracy of the measurement of the coordinate h* . 

; f 

Figure 18 shows the effects of the separation standard deviation on 
the height uncertainty^. In this case the terrain is again assumed 
to be flat v/ith zero height and no relative slope. 

The standard deviation in the coordinate a* is slightly less 
than the standard deviation in h’ for all cases with the stereo angles 
system. The standard deviation in b,as shown in Figure 19, is very 
large for the stereo angles system. The inaccuracy in the measurement 
of the coordinate b 1 increases rapidly as distance from the vehicle 
increases. If accurate discrete point locations are needed the stereo 
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Figure 18 Stereo Angles System: Standard Deviation in Height Coordinate (h*) 
Versus Distance from Vehicle for Flat Terrain with h f =0 





might be restricted to use only at close range, say within 10-15 meters. 
Heights of terrain other than zero have a noticeable but tolerable 
effect on the measurement of h as shown in figure 20. This graph shows 
the quantity (f h , vs. distance b* for h’ = +1, 0 and -1 meter v/hen L si ,0m 
0 ”k~ O.Olm and^f^s 1*. The system is more accurate for positive heights 
than for negative heights. The measurements of a'and b’are not sensitive 
to the variation in height. • , 

The stereo range system requires very good range accuracy to 

obtain good h'coordinate accuracy as seen from Figure 21, standard 

* 

deviation in height h 1 vs. distance b . The separation uncertainty has 

much less effect than the range uncertainty. To get accurate results 

the range standard deviation must be 0.001 meter or less. Figure 22 

shows the quantities (j^, and (T^, vs. distance for the stereo range 

system. The accuracy in the a' coordinate is about the same as in the 

h’ coordinate because of the symmetry of the system. The standard 

deviation is small and should pose no problem for this system. 

Figure 23 illustrates the effects of heights of terrain not equal to 

zero on the accuracy of the sterec ran e system. The measurement of a* 

is not sensitive to height variation. .The measurements of the values 

of h’ and b’ are slightly affected by terrain height variation. 

* 

The standard deviations in the coordinates h’, a' and b’ are 
plotted versus distance from the vehicle for the non-stereo system in 
Figures 24-20. This system differs from the stereo systems in that 

v/hen angle standard deviation is 1 * the standard deviation in h* fT . 

/ vh’ 

decreases considerably as the distance from the vehicle increases. 

There is some threshold value for the quantity Q~ between 1* and 10’ 
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Figure 20 Stereo Angles System: .Standard Deviation in Height Coordinate h* 
Versus Distance from Vehicle for Various Values of h* 
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Figure 22 Stereo Range System: Standard Deviations in a* and b* Coordinates 
Versus Distance from Vehicle for Flat Terrain with h* = 0 




above vfhich this effect is reversed. At close range with angle standard 
deviation equal to 1* the range uncertainty appears dominant. A value 
of(T B = 0.05m or less will give acceptable results in the measurement 
of h 1 if the value (T^= 1*. For the non-stereo system the magnitude 
of the standard deviation in the coordinate a' is always less than the 
standard deviation in h'. 

The standard deviation in the measurement of the h* coordinate 
vs. distance from the vehicle is illustrated in Figure 25. The angular 
standard deviation is I 1 for the solid lines and 10* for the dotted 
lines. The range standard deviation (fl varies from 0.01m to 0.10m. The 

A 

terrain is assumed to be flat with zero height. The uncertainty in b 1 
is approximately equal to the range standard deviation. Again the 
measurements of a' and b' are not significantly influenced by changes 
in the height h 1 . The effect of heights from + 1 meter to - 1 meter on 
the quantity^,^ are shovm in Figure 26. Angle standard deviation is 
set at 1 1 and range standsurd deviation at 0.10m, As with, the other 
systems the effects of non-zero heights is acceptable. 

The fact that the accuracy in the coordinate measurements 
improves with increasing distance from the vehicle for the non-stereo 
system explains why gradient estimates also improve with distance 
for this system as shown in the literature. [2] 






Figure 25 Non— stereo System Standard Deviation in b* Coordinate 

Versus Distance from Vehicle for Flat Terrain with h» = 0 






PART 5 


CONCLUSIONS 

A procedure for estimating a state vector x from the relation 
h = A x when h and A are stochastic measurements has been applied to 
estimate the gradient of the terrain in the path of the Martian vehicle. 
Four measurement points which do not lie on the same plane due to .. 
terrain irregularities and measurement errors are employed to form 
a least square estimate of the gradient. This least square estimate 
has been found to be more accurate than an estimate from only three 
points which lie on the plane. 

The standard deviation in the four point estimate of the 
gradient depends on the distance of the four points from the vehicle, 
the positions of the terrain points in relation to each other, the 
gradient of the terrain and the measurement errors. Vehicle motion 
effect on the standard deviation in gradient has been reduced to an 
additive factor as a result of use of a rapid-scan laser. 

The effects of the above factors on the quantity ff* are 

M sg 

shown in Figures 5—8 for a stereo angles measurement system which uses 
3 angular measurements and in Figures 9—12 for a stereo range system 
which uses 3 range measurements. A desired maximum allowable standard 
deviation in gradient has been set at 2°. These results are 

°o 

summarized and compared with the non-stereo system which uses one range 
and two angular measurements* ^ J %n the following Table. 
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TABLE . 


COMPARISON OF STEREO AND NON-STEREO 

V ' - 

MEASUREMENTS USING FOUR POINT PLANE FITTING 


SYSTEM 

MAX. RANGE 

MAX. ANGLE 

MAX. 

DISTANCE 


STD. DEV. 

STD. DEV. 

L 

, & J 


cr K 

<r 4 

STD # 

dV 

DEV. 

At 4 meters from the 

vehicle: 




Stereo Range 

0*001 meter 


0. 

005 meter 

Stereo Angles 


1 minute • 

0. 

001 meter 

Non-stereo 

0.01 meter 

1 minute 

Ml 1 1 



At 20 meters from the vehicle: 


Stereo Range 0.0005 meter — — 0.005 meter 
Stereo Angles 6 arc-sec-. 0.001 meter 
Non stereo 0.02-0,03 meter 1 minute — — — . 


From the Table and the limits of present technology, the 
non-stereo system appears much more practical than the. stereo range 
system. Laser rangefinder technology has not yet reduced range standard 

r 3 n 

deviation below 0.01 mete 2 ', * In fact, a more reasonable expectation 

("121 

for range standard deviation may be from 0,02 to 0.05m. ^ J The results 
for stereo range have been presented in anticipation of improvements 
in rangefinder accuracy. 



At longer range the non-stereo system is better than the 
stereo angles system. At close range, stereo angles nay be comparable ■ 
to non-stereo if the standard deviation in the transmitter-receiver 
separation^ can be reduced to 0.001m. Thin conclusion is also based 
on th.e assumption that angle standard deviation will be about one minute 
of arc.( 3 l 

Future research should consider the problem of coordinating 
the gradient estimates of all the small terrain areas in front of the 
vehicle. The problem of discrete obstacle detection or height dis- 
continuities should also be analyzed. A complete path selection rule 
should then be developed and tested. Other possibilities include 
rearrangement of transmitter and receivers to improve .accuracy and 
simplify operation of the obstacle detection system. 
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APPENDIX A 


Derivation of the Perturbation Equations 

To prove the results in Eqs. (12) and (13) the h, a, b 
coordinates are first perturbed as 


Vh 


m « 

h» 


b» 


$h' 

S a 

= Sc^)B(J) 

a' 

+c(^)Jb(^) 

a 1 

+C(^)0(|) 

^a* 


- 

b> 

» ^ 

b‘_ 


Sb* 


(A-1 ) 


where 


ScUc. . 


and 


Sb^o. .= 

° ^ ij 


(-sin^S^) (-cos^t^) 0 


-sin ^ -cos^ 0 


( cos^jl) (-sin^J^) 0 

- 

cos^ -sin^ 0 

if 

0 0 0 

» ■ 


0 0 0 

• « 


* 


r 


(-sin^S^) 0 (cos^^f) 


(-sin? ) 0 (cos 

0 0 0 . 


0 ' 0 

0 

(-cos^£y) 0 (-sin£ ) 


(-cos^ ) 0 (-sin 


(A-2) 


(A-3) 


For stereo angles, 


S * 1 


W 


= l) 

SC 

$*' 


Se 

* 


V L 


(A-4) 

where G is shown in Eq, (12b) in the text. The matrix G is obtained 

^ 3. 

by taking the differentials of Eqs. (la-c) with respect to*t,^,0and L. 
For stereo range, 

Sh' 

S*' 


= G r (M,H,K,L,J) 


Sm 

f N 

Sk 

Sl 

% J 

U° J 


(A-5) 


where is given in Eq. (13b) in the text. The matrix G^ is obtained 
from the differentials of Eqs. (4a-c) with respect to M,N,K,L ( and J. 
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Equations (A-2), (A-3) and (A-4) are substituted into (A-1) to obtain: 



f, 

> w 

h' 


r» 

h' 

Sa 

$ b . 

= V C 1 ^)B(p 

a* 

b' 


a* 

b» 


i5 


+c(^>)aq)G a (^,(>,«,L) 

(A-6) 


!H 


Similarly, substitution of (A--2) , (A-3) and (A-5) into (A-1) produces 


V 

r 


V a 

V — s 

*0 

21 

a* 

&b 

1 - M 

L 

b f 

tm ** 


Comparing the above with (12a) or (13a) 
D(h‘,a',b»,^/p ^^(^(J) 




b»i 


5 <f> 

A 


(^>)B(J)G r (M,N,K,L,J) 
(A-7 ) 


in 

*K 

*L 


h» 


b’ 


: c(^)s l (p 



(A-8) 


The first term on the right is determined from (A-2) and (2c) 


c’b 


h« 

a* 

b* 


coe^ 

0 


0 

1 

0 


-ein^ 
h’cosj +b f sin 


sin 
0 

cos'lj 


-sinf^ -coe^ 0 
cos^ -sin^ 0 
° 0 0 

-sin<^ -cos^ ‘ 0 ' 
cosj# -sin^zi 0 
,0 0 0 j-h’sln^ +b’cos^J 

-h 1 sin ^ cos^ -b 1 sin^ sin*^ -a'cos^ 
h’cosj^ cos^ +b'cos^ sin^ -a 1 sin^ 


The second term of (A-8) is determined from (A-3) and (2b) 


-1 

h* 


a 1 

J 

b 1 


(A-9) 


cnlc 


h» 


cog^ ~sin^ 0 


* 

-sin^ 0 cos^ 

a? 
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simp cos^ 0 
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0 0 1 
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“ 

sin^ cos^ 0 


0 



0 0 1 ^ 
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h f 
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-h 1 c os$ sin^ +b’cos^ cosjf 
-h f siii^ sin£ +b'sin/ cos^ 

-h'cosj’ -b'sinj 

Substitution of (A-9) and (A-10) into (A-8) gives 

(—h* sin^ cos — a*cos^ -b , eih^ sin^ ) 
( h'cos^ cos^ -a'sinj* +b*cos^ sinj ) 

0 


(-h* cos00 sin^ +b’cos^ cog ^ ) 
(-h'sin/tf sin^ +b‘sin^cos£) 
(-h.’cos^ -b'sin^) 


(A-10) 


D(h»,a',b«, 0 ,f ) = 


(A-l 1 ) 


APPENDIX B 

Derivation of the Covariance Matrix of the Variables 

Equation (12) is multiplied by its transpose to prove the 
result shown in Eq. (16) 
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Expected values of (B-1) are taken to obtain 
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+CBG E 
a 
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T T T 
BC 


'(B-2) 


Assuming that §<* S L » S^and are un correlated, the last two 

terms of (B-2) reduce to zero. Eq. (B-2) then becomes Eq. (16). 

Similarly, Eq. (13) may be multiplied by its transpose to yield Eq. (17). 


APPENDIX C 

Derivation of the Slope Covariances 

to prove Eqs. (21) and (22), (ISb-d) are substituted into Eq. (18a) 
to obtain 

h + £h = (A + $A)(x + £ x) = Ax + ^Ax + a£x + £a£x (C-1 ) 
The second firder term ^A$x may be neglected. Since h = Ax 
Eq. (C-1) may be reduced to 

A^x = $h - 5 Ax 

_ — /n 

This relation is pre-multiplied by A to obtain 

.A T a{x *= A T (Jh -$Ax) 

.< 

it • 

Therefore the estimate of Jx becomes ' 

Jx = (A^A)” 1 A 1 (Jh -$Ax) = F($*h - Sax) (C-2) 

9 

> This is equivalent to Eqs. (20) and (21) 

The product of Eq. (C-2) and its transpose provides 

Jx$x T = F($h- ^Ax)(^h-SAx) T F T = F|ShJh T -^h T -Sh(Ux) T +SAx(^Ax) T, l F T 

J (C-3) 

Taking the expected value of Eq. (C-3) results in Eq,(22) 


in the text. 
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Eq. (23) nay be substituted, etrn by term, into Eq.(22) 

fr 


E (Jx $x ) = B< 


E(/h J*h T ) = j 
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< ^2 
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[**1 ^2 ^ 3 ] 


(C-4) 


Sh. 
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[^1 .>„] 


EeSh^ 2 ECSh^) E(fh 1 Sh n ) 

E(Sh 2 Sh 1 ) E(Sh 2 ) 2 E (<f h 2 Sh n ) 


E(Jh Sh.) E(5h VO...E($h $h ) 
n 1 n z n n 

(C-5) 


The different measurement points are uncorrelated. Therefore, 
the off diagonal terms are equal to zero. Eq. (C-5) reduces to 

1 2 


E(£h Sh T ) = 


S( U,) - 


B(Sh n )' 


(C-6) 


Similarly ; 
E( $ Ax 


[ Sa x + Sb x [$h ...Sh i 

S(Wx$h T ) = E J : L J 

+ *V 2 
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:[s h(SAx) r l = E< 


Sh. 


Ik 


n 


• E(ia n ih n ) Xl + BtSb^h^ 


(C— 7) 


|E($h 1 Sa 1 )x 1 + E($h fb^x,. 


E(Jh n ^a n )x ] + E(Jh n £b n )x 2 


(G-8) 



E [^Ax( Sax) - ^ = E< 


+5b 1 x 2 )...(Sa n X 1 +Sb n x 2 ) J 


+ ^ 1*2 

♦ 

* 

K*1 + t b n*2 

» 1 M 

[^(Sa,)^ 2 + 2E(Ia^b 1 )x 1 x 2 + E^) 2 ^ 2 ] 


0 


« 

[^% 2 + 2E(Sa n $b n )x 1 x 2 + E(Jb n )^ 2 


(C-9) 


The expected valuee in Eqs. (C-5) through (C-9) are calculated 


from Eq. (16) or Eq. (17) in the text 



